I 


第 42 卷 第 3 期 桂林 电子 科技 大 学 学 报 Vol. 42, No. 3 
2022 年 6 月 Journal of Guilin University of Electronic Technology Jun. 2022 


一 种 基于 多 元 感知 的 电动 调 平 装置 “ 虚 腿 ”判定 方法 
付 国 华 ', 张 礼 学 *, 翟 术 和 勇 ', 张 应 红 


(1. 桂林 长 海 发 展 有 限 责任 公司 ,广西 桂林 541001; 
2. 陆军 装备 部 柳州 地 区 军事 代表 室 ,广西 柳州 ”545000; 
3. 桂林 电子 科技 大 学 机 电工 程 学 院 ,广西 桂林 541004) 


摘 要 :针对 多 点 支撑 电动 调 平装 置 在 调 平 工 作 过 程 中 易 出 现 “ 虚 腿 ” 现 象 的 现状 ,提出 了 一 种 基于 倾角 、 旋 变 和 伺服 电机 
驱动 控制 器 输出 电流 的 多 元 感知 电动 调 平装 置 “ 虚 腿 ”判定 方法 。 构 建 了 常用 四 点 支撑 电动 调 平装 置 结构 组 成 模型 ,同时 ， 
以 四 点 支撑 电动 调 平 为 例 建 立 了 调 平平 台 模型 。 对 所 提 方 法 的 判定 原理 、 所 使 用 的 追 高 判定 和 多 元 感知 多 重 判定 策略 、 具 
你 实施 过 程 “ 虚 腿 ”判定 方法 和 判定 程序 流程 进行 详细 阐述 。 所 提 方 法 无 需 增 加 新 配置 , 即 可 有 效 消除 “ 虚 腿 ”现象 ,可 为 工 
/ 感 机 械 和 陆地 国防 车 载 式 平台 装备 自动 调 平和 防止 " 虚 腿 "提供 参考 。 
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Obstract: Aim to the present situation that the multi-point support electric leveling device is prone to virtual leg phenomenon 
n 亚 iethe leveling process，a method to determine the virtual leg of multi-sensory electric leveling device based on inclination， 
Sn and output current of servo motor drive controller was proposed. The structure composition model of commonly used 
our- point support electric leveling device was constructed. Meanwhile, a leveling platform model was established by taking 


four-point support electric leveling device as an example. The principle of the proposed method, the decision strategy of pur- 


suing height and multiple perception, the decision method of virtual leg and the decision procedure flow of the specific imple- 
mentation process are described in detail, can effectively eliminate the phenomenon of virtual legs without adding new config- 
urations, and can provide reference for automatic leveling and preventing virtual legs of construction machinery and land de- 
fense vehicle platform equipment. 


Key words: virtual leg; the output current; rotary transformer; dip angle; leveling 


随 着 现代 战争 对 作战 反应 时 间 要 求 的 不 断 提高 车 载 雷 达 、 车 载 导弹 、 和 车载 激 光武 器 和 火炮 发 射 架 等 
各 类 型 武器 装备 的 机 动 性 也 越 来 越 强 ， 车 才 射 已 经 军事 设备 上 得 到 了 广泛 应 用 *" ,对 于 这 类 体积 大 、 载 
成 为 重要 趋势 '"。 在 车 载 武 器 装备 到 达 预 定位 置 后 向 重 .设备 工作 平台 水 平 度 和 抗 倾覆 性 能 要 求 高 的 装 


要 求 能 快速 架设 快速 调 平 , 因 而 调 平装 上 置 的 作用 赵 备 ,必须 采用 多 点 支撑 的 方式 ,以 保证 设备 的 支撑 刚 
来 越 重要 ” 。 当 前 ,电动 调 平装 置 在 机 动 陆地 装备 如 度 和 稳定 性 。 然 而 ,多 点 支撑 电动 调 平 装置 在 调 平 的 
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过 程 中 会 出 现 过 约束 超 静 定 问题 , 若 不 能 对 每 个 支撑 
点 进行 有 效 监控 ,准确 判定 每 个 调 平 支撑 腿 ( 以 下 简 
称 支 撑 腿 ) 是 否 触 地 ,必然 会 存在 一 个 或 多 个 支撑 点 
的 支撑 腿 因 不 受 力 而 处 于 悬空 状态 , 即 产生 * 虚 腿 ” 现 
象 口 5 

目前 ,常用 电动 调 平装 置 主要 通过 监控 支撑 腿 伺 
服 电 机 驱动 控制 器 (简称 驱动 器 ) 输 出 电流 的 变化 来 
实现 对 “ 虚 腿 "的 判定 。 伺 服 电机 在 工作 过 程 中 以 额 
定 转速 输出 , 当 支 撑 腿 触 地 并 承载 时 ,其 转 矩 发 生 较 
为 明显 的 变化 ,驱动 器 的 输出 电流 随 之 发 生 相应 改 
变 。 因 此 ,可 通过 监控 驱动 器 输出 电流 的 变化 来 判定 
其 是 否 触 地 ,一 旦 触 地 成 功 , 则 判定 “ 虚 腿 ”情况 消 
除 忠 。 基 本 判定 策略 ;通过 试验 验证 法 寻找 一 个 较为 
准确 的 支撑 腿 在 触 地 时 驱动 器 的 输出 电流 (以 下 简称 
触电 电流 ) , 设 定 为 Tu, 当 调 平装 置 开 始 工作 时 ,各 驱 
动 器 的 实时 输出 电流 设 定 为 Tue, 在 一 段 连续 的 时 间 
朵 Ca 0. 5 或 1 s), 当 某 个 驱动 器 I 之 T, 时 , 则 判定 
其 对 应 的 支撑 腿 触 地 成 功 "; 当 所 有 支撑 点 的 支撑 腿 
都 解 地 成 功 后 ,根据 相应 的 调 平 策略 和 算法 进行 自动 
调 平 。 但 上 述 判定 方法 易 受 机 械 结构 摩擦 力 的 影响 ， 
龙 基 是 长 久 贮存 或 应 用 在 冬季 寒冷 地 区 的 设备 ,支撑 
腿 入 缩 机 构 的 相对 运动 部 位 易 存在 锈蚀 或 收缩 、 结 冰 
霜 交 现象 。 当 设备 进行 调 平时 , 某 些 支撑 点 摩擦 力 会 
突然 变 大 ,致使 驱动 器 Tu 因 达 到 触 地 电流 判定 条 件 
页 虚 现 触 地 误 判 ,此 时 车 继续 调 平 ,完成 后 将 存在 “ 虚 
腿 寺 风 象 ,从 而 破坏 设备 的 支撑 刚度 和 稳定 性 ,导致 设 
备 彝 于 异常 工作 状态 , 轻 则 影响 设备 性 能 , 重 则 使 设 
答 无 法 使 用 或 发 生 危险 事故 。 

”鉴于 此 ,提出 一 种 基于 倾角 、 旋 变 和 驱动 器 Tu 
多 元 感知 的 电动 调 平装 置 “ 虚 腿 ?判定 方法 。 通 过 多 
元 感知 获取 相应 信息 ,将 多 元 信息 结合 主动 干预 控制 
调 平平 台 的 状态 变化 ,同时 辅 以 相应 的 算法 与 判定 方 
法 ,可 准确 判定 支撑 腿 是否 触 地 ,彻底 消除 电动 调 平 
装置 调 平 工作 过 程 中 的 “ 虚 腿 ? 现 象 , 保 证 设备 安全 可 
靠 工 作 。 


1 模型 搭建 


1.1 电动 调 平装 置 结构 组 成 


当前 ,四 点 支撑 电动 调 平装 置 使 用 最 为 广泛 ,其 
主要 由 调 平 腿 、 调 平 控制 箱 、 双 轴 倾 角 传 感 响 和 连接 
电缆 等 组 成 ” ,如 图 1 所 示 。 支 撑 腿 使 用 内 置 旋 变 传 
感 需 的 伺服 电机 驱动 , 旋 变 传感器 可 将 检测 到 的 电机 
转子 位 置信 号 传送 给 驱动 器 ; 调 平 控制 箱 内 部 设置 驱 
动 右 和 调 平 控制 板 , 驱 动 融 不 仅 能 将 旋 变 传 感 噩 传 来 


的 电信 号 进行 解码 并 获得 伺服 电机 的 转速 信息 ,还 可 
对 电机 进行 转速 控制 ,同时 也 能 检测 到 输出 到 伺服 电 
机 的 电流 信息 ; 双 轴 倾角 传感器 采用 全 温 补 高 频 响 
应 高 精度 双 轴 数字 输出 型 倾角 仪 ,可 检测 平面 坐标 
和 了 工 轴 方向 上 的 两 路 水 平 误 差 信 号 ,输出 与 水 平 误 


差 呈 线性 关系 的 角度 显示 信和 号 5 。 
空 制 箱 


调 平 


和 内 置 旋 变 传感器 


1 四 点 支撑 电动 调 平装 置 结构 组 成 示意 图 


1.2 平台 调 平 建 模 


四 点 支撑 电动 调 平平 台 模 型 如 图 2 所 示 。 根 据 
倾角 传感器 的 安装 位 置 ,确定 XY 轴 的 轴 向 中 中。 平 
台 前 后 方向 (车 载 平 台 前 进 或 后 退 方 向 ) 为 Y 轴 , 左 
右 方向 为 X 轴 ( 车 载 平 台 与 车 辆 行进 方向 相 垂 直 的 
方向 ) 。 传 感 器 输出 与 水 平 误 差 (角度 ) 成 线性 关系 的 
X.Y 轴 的 数字 信号 ,通过 该 信号 可 找 出 平台 的 最 高 
点 [12] 。 

图 2 中 平台 的 腿 1、2 端 为 Y 轴 的 正方 向 ;平台 Y 
轴 正 方向 左 侧 为 X 轴 的 正方 向 。2 条 相交 且 垂 直 的 
直线 ED 和 EF 所 在 平面 为 水 平面 ,a 为 平台 与 水 平 
面 在 X 轴 方 向 上 的 夹 角 ,PB 为 平台 与 水 平面 在 Y 轴 
方向 上 的 夹 角 。 通 过 倾角 传感器 检测 X 了 方向 上 的 
倾角 值 a、8, 根 据 倾角 的 正 负 可 判定 平台 支撑 的 最 高 
支撑 点 和 最 低 支撑 点 50。X 了 轴 倾 角 显 示 为 正 数 
时 , 则 X 了 轴 正 方向 处 于 高 位 ,反之 , 则 X、 工 轴 负 方 
向 处 于 高 位 。 图 2 中 所 示 状 态 ,倾角 传感器 的 六、Y 
轴 倾 角 均 为 正 数 , 即 w 盖 0,8 二 0, 由 此 可 知 腿 1.、2 一 
端 高 于 水 平面 ,为 平台 Y 轴 方 向 的 高 位 , 腿 3、4 一 端 
则 为 平台 Y 轴 方 向 的 低位 ; 腿 1、3 一 端 也 高 于 水 平 
面 ,为 平台 X 轴 方 向 的 高 位 , 腿 2、4 一 端 则 为 平台 X 
轴 方 向 的 低位 ;因此 腿 1 位 置 为 平台 的 最 高 点 , 腿 4 
位 置 为 平台 的 最 低 点 "5 。 

假设 腿 1、2, 腿 3、4 的 X 轴 向 间距 为 B; 腿 1、3 
与 腿 2、4 的 Y 轴 向 间距 为 L; 腿 4、2 在 Y 轴 方 向 上 的 
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< 面 落 差 为 也 y,4, 腿 4、3 在 XX 轴 方 向 上 的 水 平 


2 平台 调 平 模型 


倾角 传感器 


面 缆 差 为 Hx.s, 腿 3、1 在 Y 轴 方向 上 的 水 平面 落差 
净 和 和 y,,, 腿 2.1 在 X 轴 方 向 上 的 水 平面 落差 为 
Hesa, 则 Hy,» = Hy,a=L tanB, Hx.s= Hex, = 
Bian a 


2 忆 : 虚 腿 ” 判 定 原理 .策略 


2.1 判定 原理 


以 四 点 支撑 电动 调 平装 置 为 例 , 在 不 增加 配置 的 
前 提 下 , 调 平 控制 板 通过 双 轴 倾角 传 感 顺 采集 平台 在 
XX、Y 轴 的 角度 信息 ,通过 旋 变 传感器 采集 伺服 电机 
转速 信息 和 驱动 器 输出 电流 信息 ( 见 图 3) ,并 采用 相 
应 的 策略 通过 主动 干预 控制 各 个 调 平 腿 的 伸 出 速度 、 
伸 长 量 来 改变 平台 的 水 平 状 态 ,并 观察 平台 水 平 状 态 
变化 与 支撑 腿 工 作 状 态 变 化 的 相互 关系 ,以 判定 各 文 
返点 的 调 平 腿 是 否 触 地 , 若 已 触 地 , 则 ”* 虚 腿 ? 消 除 , 和 否 
则 存在 “ 虚 腿 天 ”1 。 


2.2 判定 策略 


根据 倾角 传感器 的 工作 原理 ,结合 平台 调 平 装置 
工作 的 安全 性 需求 ,采取 “ 追 高 判定 ”多 元 感知 多 重 
判定 策略 。“ 追 高 判定 ?主要 根据 倾角 传感器 获取 的 


输出 


日 I 
0) 
要 


位 置信 号 


旋 变 传感器 


图 3 多 元 信息 采集 传输 框图 


平台 水 平 状态 信息 ,由 程序 判断 出 最 高 点 ,保持 相对 
最 高 点 不 动 , 按 照 从 低 到 高 的 顺序 向 最 高 点 靠拢 ， 
逐个 测试 每 个 支撑 腿 的 虚实 ;将 要 测试 的 支撑 腿 往 下 
伸 长 ,直到 倾角 传感器 在 X .了 轴 的 任意 一 个 方向 变 
化 到 一 定 范围 ,判定 过 程 只 升 不 降 , 即 向 最 高 点 看 
齐 ”  ; 当 确 认 所 有 支撑 点 均 无 “ 虚 腿 ”后 ,再 进行 后 
续 的 自动 调 平 工作 。 多 元 感知 多 重 判定 策略 则 是 为 
了 提高 平台 “ 虚 腿 ”判定 过 程 的 安全 性 。 通 过 同时 检 
测 倾 角 传 感 絮 在 X、Y 轴 的 倾角 、 伺 服 电 机 的 转速 及 
某 个 支撑 点 支撑 腿 输 出 电流 的 变化 ,判定 支撑 腿 是 否 
成 功 触 地 ,以 消除 “ 虚 腿 ”可 避免 出 现 诸如 支撑 腿 出 
现 机 械 故 障 ( 如 摩擦 力 增 大 )、 平 人 台 自 身 结构 刚度 不 
够 .伺服 电机 工作 异常 及 倾角 传 感 带 的 故障 等 可 能 

致 误 判 的 现象 ,消除 单个 信息 源 造成 的 异常 影响 , 保 


回 
6] 
口 
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障 设备 安全 。 以 四 点 支撑 调 平装 置 为 例 。 


2.2.1 判定 方法 

在 图 2 所 示 的 平台 调 平 模型 平台 上 配置 图 1 所 
示 的 四 点 支撑 电动 调 平装 置 。 假 设 其 调 平 精度 为 
6', 双 轴 倾 角 传感器 的 分 辨 率 为 0.06', 支 撑 腿 的 额定 
伸 出 速度 v 一 4 mm/s, 触 地 电流 为 Ts。 由 于 倾角 传 
感 器 的 分 辨 率 很 高 ,反应 过 于 灵敏 ,容易 受到 干扰 , 因 
此 以 调 平 精度 值 作 为 判定 的 临界 值 (也 可 根据 实际 需 
求 与 设备 配置 确定 ) 。 判 定 依据 :1) 支 撑 腿 的 工作 正 
常 ;2) 某 个 支撑 点 的 支撑 腿 开始 工作 前 和 工作 一 定时 
间 后 导致 倾角 传感器 的 X 轴 或 Y 轴 倾 角 变化 量 大 于 
或 等 于 临界 值 ( 即 6 ;3) 倾 角 传感器 的 X/Y 轴 倾 角 
变化 量 大 于 或 等 于 临界 值 后 ,支撑 腿 驱 动 器 的 输出 电 
流 Sb 之 I。 当 3 个 条 件 皆 满足 时 , 则 可 判定 该 支撑 
点 的 支撑 腿 已 触 地 ,“ 虚 腿 ” 消 除 。 
一 在 临界 角度 值 为 6 支撑 腿 伸 出 速度 v 的 条 件 
TEX 了 轴 方 向 上 判定 前 后 的 最 小 高 度 落差 分 别 为 
FE = Btan 6'=0.017 5B、H »%, =Ltan 6'= 0.017 
56s 刘 判定 其 所 需 最 短 时 间 分 别 为 Tx 二 Hxw /4 二 
0C800 44B 、Ty.wo 二 Hymn/4 二 0.000 44L。 常 见 的 陆 
所 设备 载 车 ,一 般 卫生 6 000 mm,B 志 2 400 mm 在 
紫 服 工 =6 000 mm, B=2 400 mm, 则 Ty = 
2.84 s, Ty 一 1.06 s。 鉴 于 控制 主板 采集 信息 及 
程序 运行 的 响应 时 间 均 为 毫秒 级 ,采用 6 的 临界 角 
度 入 作为 判定 条 件 是 合理 的 。 另 外 ,上 述 第 3 个 判定 
条 手 主要 是 为 了 检测 和 防止 倾角 传感器 工作 中 出 现 
异 需 , 只 需 判断 空 载 和 触 地 后 轻微 负载 的 状态 即 可 ， 
触 驻 电流 可 以 取 一 个 较 小 的 理论 值 。 因 此 ,在 实际 应 
用 中 ,由 于 临界 角度 值 和 触 地 电流 值 均 较 小 ,判定 过 
程 中 各 支撑 点 处 的 平台 位 置 变化 及 判定 完成 后 平台 
的 水 平 状态 变化 就 会 很 小 ,使 用 本 判定 方法 判定 “ 虚 
腿 ” 所 需 时 间 短 .过 程 稳定 性 及 安全 性 较 好 


2. 2. 2 判定 流程 

首先 判断 Y 轴 方 向 上 的 高 低 , 先 将 低 的 一 端 (2 
个 支撑 腿 同 时 升 高 ) 升 高 到 一 定 范围 ,判断 该 端 X 轴 
方向 上 的 高 低 ,将 低 的 一 侧 先 升 高 至 “ 虚 腿 ”消除 , 接 
着 再 升 高 男 一 侧 至 “ 虚 腿 ”消除 ;然后 再 升 高 Y 轴 方 
向 高 的 一 端 (2 个 支撑 腿 同 时 升 高 ) 到 一 定 范围 ,此 时 
判断 该 庙 X 轴 方 向 上 的 高 低 ,将 低 的 一 侧 先 升 高 至 
“ 虚 腿 ”消除 ,再 升 高 男 一 侧 至 “ 虚 腿 ”消除 。 

以 图 2 中 的 平台 调 平 模型 为 例 ,具体 流程 见 图 
4。 从 调 平装 置 启动 并 进入 自动 工作 模式 开始 ,自动 
工作 模式 分 为 “ 虚 腿 ”消除 和 自动 调 平 2 个 阶段 。 第 
1 阶段 控制 4 个 支撑 腿 伸 出 至 触 地 并 检测 4 个 支撑 


腿 全 部 触 地 则 完成 中 。 第 1 阶段 开始 时 首先 读 取 
X.Y 轴 倾 角 值 并 存储 , 设 此 时 XX、Y 轴 的 倾角 值 分 别 
为 wo、 B, ,和 若 B 0, 则 说 明 平 台 在 立轴 方向 上 , 腿 1、2 
一 侧 处 于 高 位 。 为 保证 判定 过 程 的 安全 ,“ 虚 腿 ” 判 定 
从 处 于 低位 的 腿 3、4 开始 ,此 时 通过 主动 干预 使 腿 
1.2 以 0.9z 伸 出 , 腿 3.4 以 v 伸 出 ,实时 读 取 、 存 储 
X 了 轴 的 倾角 值 ci .8 ,正常 情况 下 腿 3、4 将 先 触 
地 , 即 不 满足 有 一 8 二 3 同时 在 未 满足 B, 一 8 过 6- 
前 ,4 个 支撑 腿 继续 保持 原 设 定 速度 伸 出 。 当 Bo 一 Bi 
宇 6' 且 a 之 0 时 , 腿 4 继续 以 v 伸 出 ,其 余 腿 停止 动 
作 , 继 续 实 时 读 取 、 存 储 XX、Y 轴 的 倾角 值 as、B; ,同时 
读 取 腿 4 驱动 器 的 输出 电流 Lo; 当 满 足 a 一 a;, 宇 6 
且 之 Ts 时 ,判定 腿 4 已 触 地 ,“ 虚 腿 ” 消 除 ,此 时 
腿 3 以 v 伸 出 ,其 余 腿 停 止 动 作 , 继 续 实 时 读 取 、 存 储 
X,Y 轴 的 倾角 值 cs 、B; ,同时 读 取 腿 3 驱动 器 的 输出 
电流 0; 当 满足 a 一 Qs 宇 6 且 T1304T;, 时 ,判定 腿 
3 已 触 地 ,“ 虚 腿 ” 消 除 ,此 时 腿 3、4 停止 动作 ,和 腿 1、2 
以 wv 伸 出 ,继续 实时 读 取 并 存储 X、Y 轴 的 倾角 值 a 
和 Bi; 当 满 足 B, 一 8B; 宇 6' 且 ai 写 0 时, 腿 2 继续 保持 
额定 速度 伸 出 ,其 余 腿 停止 动作 ,继续 实时 读 取 并 在 
储 X、Y 轴 的 倾角 值 a; 和 B; ,同时 读 取 腿 2 驱动 器 的 
输出 电流 T2041; 当 满足 w 一 xs 二 6 且 Toi 记 T;, 时 , 判 
定 腿 2 已 触 地 ,“ 虚 腿 ” 消 除 ,此 时 腿 1 以 v 伸 出 ,其 余 
腿 停 止 动作 ,继续 实时 读 取 并 存储 X、Y 轴 的 倾角 值 
ae、Bs ,同时 读 取 腿 1 驱动 器 的 输出 电流 i; 当 满足 
ai 一 05 人 6 且 Tw 记 Ts, 时 ,判定 腿 1 已 触 地 ,“ 虚 腿 ” 
消除 ,此 时 所 有 支 撑 腿 均 已 消除 “ 虚 腿 ”, 可 进入 第 2 
阶段 ,开始 自动 调 平 工作 。 

由 于 设备 实际 调 平 工作 环境 较为 复杂 ,通常 基于 
倾角 、 旋 变 和 了 驱动 器 输出 电流 多 元 感知 来 判定 设备 平 
台 各 支撑 点 支撑 腿 的 “ 虚 腿 ”状况 ,具体 程序 流程 见 图 
4。 因 驱动 器 内 置 控制 电路 能 直接 感知 .检测 伺服 电 
机 的 工作 状态 , 仅 对 伺服 电机 的 转速 做 相应 的 控制 ， 
以 改变 支撑 腿 的 实际 伸 出 速度 。 图 4 中 在 腿 1、2 以 
0.9v 伸 出 , 腿 3、4 以 wv 伸 出 的 指令 后 ,增加 B1 一 Bo 二 
3 的 判定 条 件 ,是 为 了 解决 腿 1.2 先 触 地 情况 下 , 腿 4 
触 地 判定 周期 长 或 无 法 判定 哪个 支撑 腿 触 地 的 问题 ， 
因为 腿 1.2 悬空 高 度 相 比 腿 3、4 要 小 很 多 , 腿 4 全 部 
伸 出 前 ,无 法 满足 判定 条 件 。 正 常情 况 下 , 腿 3、4 将 
先 触 地 ,但 一 旦 出 现 腿 1.2 惹 空 高 度 相 较 腿 3、4 小 很 
多 的 情况 ,就 可 能 出 现 腿 4 伸 出 很 长 或 完全 伸 出 后 才 
能 达到 判定 条 件 , 其 至 出 现 完全 伸 出 也 达 不 到 判定 条 
件 的 情况 ,导致 判定 周期 很 长 或 出 现 故障 。 因 此 ,图 
4 中 在 文 撑 腿 伸 出 时 都 要 检测 其 是 否 已 经 达到 行程 
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进行 自动 调 平 | 读 取 、 存 储 总 了 
工作 模式 “| “| 轴 倾 角 值 fo,ao 


读 取 、 存 储 蕊 34 倾 | 。 | 腿 3、 腿 4 以 0.9v 伸 出 , 腿 | N < > 腿 1、 腿 2 以 0.9v 伸 出 ， 腿 | | 读 取 、 存 储 忆 到 由 倾 


器 


下 


角 值 wp 1、 腿 2 以 v 伸 出 3、 腿 4 以 y 伸 出 值 wp 
N 立 | 腿 3、 腿 4 停止 动作 ， 腿 1、 腿 2 停止 动作 ， 三 N 
退 1、 腿 2 以 y 伸 出 腿 3、 腿 4 以 v 伸 出 
胆 2 以 v 伸 出 ， 其 | | 腿 4 以 v 介 出， 
余 腿 停止 动作 余 腿 停 止 动作 
腿 1 以 v 伸 出 ， 其 余 读 取 、 存 储 孔 7 轴 倾 角 值 读 取 、 存 储 也 7 轴 倾 角 值 腿 3 以 v 伸 出 ， 划 
了 腿 停止 动作 azp2， 腿 2 输出 电流 Dow ow, 忆 ， 腿 4 输出 电流 ow 余 腿 停止 动作 | 
v v 
读 取 、 存 储 和 7 轴 倾 角 值 . N ， 读 取 、 存 储 站 7 负 倾角 值 
oof， 腿 1 输出 电流 ow ET ac ooBy， 腿 3 输出 电流 ow 
Y 时 
9 了 
退 ， 腿 1 以 v 伸 出 ， 退 ， 腿 3 
| 6 Hh) 
CO 到 
V v y v 
二 腿 1 触 地 ， 腿 2 以 v 促 读 取 、 存 储 X,7 轴 倾角 值 读 取 、 存 储 X7 轴 倾角 值 退 3 触 地 ， 腿 4 以 v 伸 
= 出 ， 其 余 腿 停止 动作 asp3， 腿 1 输出 电流 Tow as,B3， 腿 3 输出 电流 Dow 出 ， 其 余 腿 停止 动作 
门 Y 里 
© 读 取 、 存 储 隐 7 轴 倾 角 值 N N 读 取 、 存 储 卫 7 轴 倾 角 值 
od | | oop， 腿 2 输出 电流 im 人 caps， 妥 4 输出 电流 Lo 
CN Y 
v v 
ON 腿 1 或 腿 2 触 地 ， 腿 3、 腿 4 腿 4 或 腿 3 触 地 ， 腿 1、 腿 2 
© 以 w 伸 出 ， 其 余 腿 停止 动作 以 v 伸 出 ， 其 余 腿 停止 动作 
AN 
> 读 取 、 存 储 XY 读 取 、 存 储 了 XY 
< 轴 倾角 值 ap，|™ ”| 轴 倾 角 值 cp 
v 
5G 腿 、 时 | 、 Ud 时 、 1 "| 、 品 上 
腿 3 以 vy 伸 出 ， 其 余 腿 4 以 v 伸 出 ， 其 余 以 v 伸 出 ， 其 腿 1 以 v 伸 出 ， 其 余 
所 | ”| 腿 停 止 动作 腿 停止 动作 良 停止 动作 腿 停止 动作 
em v v v v 
O 读 取 、 存 储 系 Z 负 倾角 值 读 取 、 存 储 生 7 轴 倾 角 什 读 取 、 存 储 了 7 得 倾角 值 读 取 、 存 储 和 7 轴 倾 角 值 
Qsy s, 腿 3 输出 电流 Bou Qsy 5, 腿 4 输出 电流 Low Qsps5, 女 2 输 出 电流 Pou Qsy ;, 腿 1 输出 电流 mou 
N N N 
Qs-04 宇 6' 有 日 Bou>h C4-05 之 6 7 i 04-0s>6' Don>h 0s-04>6' Hlion>h 
本 至 
v v v y 
女 3 触 地 ， 腿 4 以 v 促 撒 4 触 地 ， 腿 3 以 v 伸 滔 2 触 地 ， 腿 1 以 v 伸 退 1 触 地 ， 腿 2 以 v 伸 
出 ， 其 余 腿 停止 动作 出 ， 其 余 腿 停止 动作 | ”出 ， 其 余 腿 停止 动作 出 ， 其 余 腿 停止 动作 | 
V M4 v y 
读 取 、 存 储 X%Y 轴 倾角 值 读 取 、 存 储 XY 轴 倾角 什 读 取 、 存 储 生 7 轴 倾 角 值 读 取 、 存 储 生 7 轴 倾 角 值 
Qey 6, 腿 4 输出 电流 Lo Rs 6， 退 3 输 出 电流 Bou Qep6, 退 1 输 出 电流 Liou Qep6, 退 2 输 出 电流 Dow 
Qs-06 宇 6' Hou>h 06-a5 过 6 1/ Re N Qa6-0s=6' Hlion>h as-06=6' Hbon>h N 
至: 至 ， 是 YY 
v v v y 
腿 4 触 地 ， 所 有 腿 虚 腿 消 腿 3 触 地 ， 所 有 腿 虚 腿 消 昌 1 触 地 ， 所 有 腿 虚 腿 消 腿 2 触 地 ， 所 有 腿 虚 腿 消 
除 ， 停 止 所 有 腿 动 作 除 ， 停 止 所 有 腿 动作 除 ， 停 止 所 有 腿 动 作 除 ， 停 止 所 有 腿 动作 
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